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ABSTRACT 


The Marine Corps and Army are developing a 
Position Locating Reporting System to ald the 
battlefield commander in locating his assets during 
battle. 


This study has applied Extended Kalman Filtering 
technigues to that problem, evolving from ae simple 
Extended Kalman Filter Observer to three moving 
observers, whose position is uncertain, estimating the 


position cf another unit. 
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Ie ENTRODUCTION 
= 


The precise location of all assets in and about the 
battle area is of prime importance to the tactical Marine 
Commander. In the past locating has had to depend on the 
individual knowing his own position and being able to report 
it through radio links to higher command. This systen 
suffered from the limitations of terrain, daylight, weather, 
and the volume of radio traffic during battle. 


To alleviate these shortcomings the Marine Corps and 
Army are investigating a Position Locating and Reporting 
System (PLRS) to collect, process, and, display the location 
of units, vehicles, and aircraft in and about the battle 


arede 


The PLRS consists of field units and a master unit. The 
field unit is compact enough to be carried in the field by a 
man, vehicle, or aircraft. These units will determine the 
range to other field units in the area and report this 
information to the master unit for processing and display. 
The range information is determined by measuring the time 
required to send a signal from one unit to another and back 
again plus some "system" delay. When a unit's position is 
being updated it is referred to as the " Update" unit; and 
all others are referred to as "Ranging" units. 


In a previous study in this area,{1], tests were 
conducted to investigate the use of the error ellipse in 
visually displaying the degree of uncertainty of the 
position of an update unit and the effect of numerous 


updates on reducing that degree of uncertainty . It was 





found that the degree of uncertainty 1s reduced in the 
direction of the ranging unit with consecutive updates as 


shown in Pig 1 taken from that study. 


That study also simulated one jet aircraft flying Mach 1 
in a constant radius turn as an update unit being ranged on 
by two stationary ranging units to explore the proper randon 
forcing excitation covariance necessary for adequate filter 


performance. 


It is the wWwatent of this study to further expand the 
Simulation begun in the previous work by adding an 
additional ranging unit, allowing the movement of the 
ranging units, and considering the effect of ranging from a 


unit whose position is not known exactly 
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Figure 1 -—- CONSECUTIVE UPDATES WILL REDUCE THE DEGREE OF 
UNCERTAINTY IN THE DIRECTION OF THE RANGING UNIT 
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II. EXTENDED KALMAN FILTERING 


3 = eee eee ee am EEE eee eS ee 


The Extended Kalman Filter is widely documented and no 
attempt at a development of that theory will be made in this 
work. A brief treatment has been included to establish 
nomenclature and formulas used. Por a more complete 
development one is referred to reference (2] or similar 


texts. 


As defined in this work, PLRS is described by a set of 
discrete, linear, cartesian system eguations 


x(k+1) = O(k) x(k) + D(k) _w(k) (1) 


and a set of discrete non-linear measurement equations 


~ 


_Z(k) = m(x(k),k) + v(k) (2) 


where ® and [f are linear functions and m is a nonlinear 
Function of the state wariables x(k); w(k) is the excitation 


noise and v(k) is the measurement noise of the systen. 


The plant noises are considered uncorrelated, zero-mean, 
and white. 


The non-linear measurement equations can be linearized 


by expanding equation (2) around the best estimate at time k 
and using the first-order terms yielding 


12 





zZ(k) = H(k) x(k) + (kx) 


where 


x (k/k) is the estimated value of the state at k after 


th P 
the k measurement and x(k/k-1) 1s the predicted value of 


th 
the state at time k before the k measurement. 


The state error wector 15s 


“A. 


me’ (k/k) = a (67K) - x(k) 
and the predicted error vector is 
x" (k/k-1) = x(k/k-1) - x (k) 


The covariance of the state error matrix is 


A a ae 
P(k/k) = EL x" (k/k) x" (k/k) ] 


and the predicted cowariance of the state error matrix is 


. . 7 
P(k/k-1) = E(x" (k/k-1) x" (k/k-1)] 


13 





The state excitation matrix is 


: T T 
Q(k) = BLE(kK) w(k) wo (k) 0 (k) ] 


and the measurement noise covariance matrix is 


T 
R(k) = BLv(k) wv (k)] - 


The equations that made up the Kalaan Filter used 
this work are as follows: 


T 
P(k/k-1) = %(k) P(k/k) & (kK) + Q(k) 


T Ie aul 
G(k) = P(k/k-1) H (k)CA(k) P(k/k-1) H (kK) + R(K) J 


P(k/k) = [I - G(k) H(k) JP (k/k-1) 
x (K/k) = x (k/kK-1) + G(k)(z(k) - H(k) x(k/k-1) J 
x(K/k71) = $(k) x(k/k) 


Z(k) = m(x(K/k-1) ,k) 


bis] 


Since the only observations in this system are ranges, 


14 





the observation equation is 


1/2 
z (Kk) = (x2 (k) + y*(k) ] ; 


- 


and from equation (3) we get 


Xx (Kk) y (k) 


(i a 000 Wee fe 
x2(k) + y? (k) x2 (k) + y2(k) 


The covariance of estimation error,>, is and expression 


of the uncertainity in the estimation of the 


states. 
Considering only the estimation's position error, P aa 
position 
can be expressed as 
ae OO 
x xy 
P es , = 
-pasition 
2 
O.,0 0] 
yx y 
Since the position estimation error is normally 


distributed, a curve of constant error probability can be 


defined by using the exponent of the normal distribution, 


xe 2r XY y@ 
XY 

a + 

o® co oO o* 

x x Y ye 
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This curve defines an ellipse. Graphically, for the given 
probability, the estimation may be anywhere in that ellipse. 
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III. CHOOSING THE BEST RANGER 


To move from a Simple Kalman Filter observer to the PLRS 
model, the first probiem encountered was to choose the best 
ranger from which to take the measurement. In the previous 
work ,{1], it was shown that the most useful measurement, 
the one causing the most reduction in the error ellipse, is 
obtained by observing the update unit from a point aligned 


With the major axis of the error ellipse of the update unit. 


To find the ranger most closely aligned with the major 
axis of the update unit's error ellipse the orientation of 
the error ellipse must first be found using the following 


equation. 


2 Cov (x,y) 


= 2 
0 0 


X y 


9 = eean-* 
: 2 


This angle(§) gives the angle between -909 and 909 that the 
x-axis of the ellipse makes with the x-axis of the 
co-ordinate system. Looking at the ellipse in this new 
posture one can find the new "Uncorrelated" variances that 


define the major and minor axes. 


Fibs SoS See 


x 2 Sin 28 


Soe cone Cov (x,y) 
y 2 Sine2s 
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If g2 1s greater than og? the x-axis of the error ellipse 
x 


is the major axis and 9 is the angle we seek. [If ,2 is 
Y 


greater thano#2 then the y-axis of the error ellipse is the 
x 


major axis and the angle we seek is 9+90°9,. 


The bearing of the update unit from the ranger must then 
be found and it 1s simply 


The absolute value of the difference between 9 after 
proper correction, and 8 was chosen as the best alignment 
indicator; but to be aligned and to be 1809 out of alignment 
is of equal value; therefore the absolute value of the 
cosine cf the differences was used as the alignment 
indicator and the ranger found to have the largest indicator 


was chosen as the ranging unit for that measurement. 
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rvV« FERS SeOULATION 


A. TWO RANGING UNITS 


In previous work,{1], the PLRS simulation was setup for 
a jet aircraft flying Mach 1 in a constant 10 Km turn about 
the origin to act as the update unit for all measurements. 
Two stationary ranging units were placed at the origin and 
at 10Km north, 10Km east. Using a one second sample 


interval, the jet was described by the following matrices: 


1 1 0) 
¥) 1 
o = 
0 1 1 
0 1 
O25 
1 
| Be = 
0.5 
1 
Its initial state was 
Q 
0.333 Kn/s 
x = 
10 Km 
0 
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Its initial covariance of error matrix, measurement noise 


covariance, and excitation forcing matrix were 


-4 -4 
10 0 10 0 
-4 
10 0° 0 
P(1/Q) = 
-4 =-4 
10 0 10 0 
-4 
0 0 Q 10 
and 
-4 
R = 10 
with 
-5 -5 
225x410 5x10 0 0 
-5 -4 
5x10 10 0 0 
Q = 
: 5 4 
0 0 2-5x10 ae 10 
#5 -4. 
0 0 5x10 10 


Fig 21s a dispiay of its final fruns. The filter 
tracked accurately andthe error ellipses shown are twenty 
times their actual size to make them visible. Table 1 shows 


which was the ranging unit at each measurement time. 
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Figure 2 ~ 
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TOE RANGER TIME RANGER TIME RANGER 


i 2 21 2 41 i 
2 1 22 1 42 2 
3 2 23 2 43 1 
4 i 24 1 44 2 
5 2 25 1 45 1 
6 1 26 2 46 2 
i! 2 27 1 47 1 
8 1 28 2 48 2 
9 2 29 1 49 1 
10 1 30 2 50 2 
11 2 31 7 51 1 
12 1 32 2 52 2 
13 2 33 1 53 1 
14 i 34 2 54 2 
15 2 35 1 55 1 
16 1 36 2 56 2 
17 2 sy i 57 1 
18 1 38 2 58 2 
19 2 39 1 59 1 
20 1 40 2 60 2 
TABLE 1 - THE RANGER CHOSEN AT EACH TIME FOR THE PLRS TWO 


STATIONARY RANGER SIMULATION 


Ze 





a 








B. THREE RANGING UNITS 


The first step of this study was to add a third ranging 
unit at OQ north, 10Km east. The algorithm was enlarged to 
include the additional unit and its comparison with the 


alignment indicators of the other ranging units. 


It can be seen in Fig 3 that the size of the error 
ellipses were reduced in size in the mid-range area where 
the jet and the two original units were in line; and the 


third ranger provides the triangular measurement. 


Table 2 shows the ranging unit chosen for the 


measurement at each time kK. 
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Pigure 3 - PLRS SIMULATION ~ A JET IN A CONSTANT 10KM 
RADIUS TURN FLYING AMONG THREE STATIONARY RANGERS 
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TIME RANGER TIME RANGER TIME RANGER 


i 2 7h 2 41 1 
2 1 22 3 42 3 
3 2 28 2 43 i 
4 i 24 3 44 3 
5 2 25 " 45 1 
6 1 26 3 46 3 
7 ” 27 1 47 1 
8 i 28 3 48 2 
9 2 29 1 49 1 
10 i 30 3 50 2 
iat 2 31 1 51 1 
12 1 32 3 52 3 
13 2 33 i 53 1 
14 3 34 3 54 3 
15 a 35 1 55 1 
16 3 36 3 56 3 
17 2 37 i 57 1 
18 3 38 3 58 3 
19 2 39 f 59 1 
20 3 40 3 60 3 
TABLE 2 - ‘THE RANGER CHOSEN AT EACH TIME FOR THE THREE 


STATIONARY RANGER SIMULATION 
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C. RANGING UNITS IN MOTION 


In the second step the rangers are given motion. The 
rangers at the origin and at 10Km north, 10Km east were to 
move north and south respectively at 3Kts as infantrymen. 
The ranger at Q north, 10Km east was to nove west at 120Kts 
as a helicopter. Again using one second sample intervals, 
their motion was defined using discrete linear state 


equations 


x(k+#1) = 9(k) x(k) , 


where 


~ 


With the initial states shown below; 


x = INFANTRYMAN 
0 
1.67x103 Kn/s 


x = INFANTRYMAN 
10 
~1.67x103 Kn/s 
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12 


-5.5595x102 Kam/s 
xXx = HELB@OPTER 


It can be seen ik Fig 4 that no system depreciation 
resulted from the motion of the rangers, Table 3 shows the 


Canging unit chosen for the measurement at each tine, 
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A JET IN A CONSTANT 


PLRS SIMULATION - 
RADIUS TURN FLYING AMONG THREE MOVING RANGERS 


Figure 4 - 
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TEME RANGER TIME RANGER TIME RANGER 


a 2 21 3 41 3 
2 1 22 2 42 a 
c) 2 23 — 43 2 
* Ih 24 2 44 IL 
2) 2 25 3 45 2 
6 1 26 iL 46 Ih 
7 2 2a) ) 47 Z 
8 IL 28 1 48 1 
=) 2 2 3 49 2 
10 1 30 1 30 ls 
11 2 31 3 Syk Z 
2 IL oz 1 52 1 
deg 3 33 3 53 2 
14 I . 34 a D4 1 
15 3 55 3 55 2 
16 Z 36 ik 56 i 
17, 5 Sy, 3 a7 2 
18 2 38 1 58 Ih 
1g 3 39 3 Dg 2 
20 2 40 iL 60 i 
TABLE 3 = THE RANGER CHOSEN AT EACH TIME FOR THE THREE 


MOVING RANGER SIMULATION 
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D. SOURCE OF MEASUREMENT NOISE 


.In the above simulations the position of the ranging 
unit has been assumed to be exact; while in actual 
application the ranging units will have covariances of 
estimation error defining an error ellipse; and the ranging 
unit might be anywhere within that ellipse. To bring this 
position uncertainty into the simulation, the radius of the 
error ellipse along the bearing from the ranging unit to the 
update unit was defined as the covariance of measurement 


Si Or . 


The equation for the radius of an ellipse is a function 
of the major axis, the minor axis, and the angle at which 
the measurement is made. To find the measurement noise 


Gemesiance, Or the ellipse radius, ,#' and ,#" must be 


x Y 
compared and the larger defined as Mj, the major axis, and 


the smaller defined as Mn, the minor axis. The angle, a , at 
which the radius is determined is measured from the major 
axils and thus is calculated as the difference betweené and 
8. Fig 5 shows the geometry of the calculation of the 
covariance of measurement noise. The equation for R and the 


radius squared of the ellipse is: 


slg} bat 


Mj Sin@a + Mn Cos2a 


It can be seen in Fig 6 that performance was improved 
slightly using the covariance of estimation error as the 


sole source of measurement noise. 
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Table 4 shows the ranger chosen at each time for the 


three moving rangers with position uncertainity simulation. 
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Figure 5 ~ 0 IS THE RADIUS OF THE ERROR ELLIPSE - r2 = R 
IS THE COVARIANCE OF MEASUREMENT NOISE 
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PLRS SIMULATION - A JET IN A CONSTANT 10K4M 


Figure or 
RADIUS TURN FLYING AMONG THREE MOVING RANGERS WITH POSITION 


UNCERTAINTY 
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TIME RANGER TIME RANGER TIME RANGER 


1 2 IAN 2 41 iL 
2 1s Z2 é 42 2 
3 2 23 2 43 1 
4 iL 24 3 44 2 
5 2 25 1 45 it 
6 i 26 3 46 Zz 
7 2 a7, i 47 i 
8 Ih 28 3 48 2 
9 a 29 Ih 49 il 
10 3 30 3 50 2 
11 i sul 1 Sill li 
1 3 32 3 as 2 
li us oS ili a8 iL 
14 g : 34 5 54 Z 
1S. it 35 : 35 il 
16 3 36 3 56 2 
dey, 1 oy 1 aT i 
18 3 38 3 58 2 
19 2 39 1 58) it 
20 5 40 3 60 Z 
TABLE 4 - THE RANGER CHOSEN AT EACH TIME FOR THE THREE 


MOVING RANGERS WITH POSITION UNCERTAINTY SITAULATION 
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The placement of the third ranger showed the value of 
triangulation of the rangers. The closer to normal the 
bearings of the rangers are to each other, the better the 
results of consecutive ranges. 


The allowance for motion and the representation of the 
ranger's position uncertainity as the source of measurement 
error were important steps toward full simulation of the 
System; and they were accomplished without degradation of 


performance. 


A better simulation may be to represent the measurement 
error as the ranger's position uncertainty plus some system 
measurement error. 

Still to be accomplished is the ability to update all 
units at each ranging, and to provide a gating system that 
will demand more frequent updates for faster moving units 


and less frequent updates for slower units. 
A program listing of the three moving rangers with 


position uncertainity is. included with an annotated data 
deck. 
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